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ABSTRACT 

In  a  tactical  missile  v/ith  mid-course  guidance,  an 
Inertial  Navigation  System  (INS)  is  required.   Strapdown  INS 
using  Steady-State  Kalman  Filters  (SKF)  as  estimators  has 
been  suggested  and  this  kind  of  INS  is  considered  to  be 
easier  and  cheaper  to  implement  than  the  gimbaled  INS. 

This  thesis  investigates  one  aspect  of  the  INS  problem: 
The  sensitivity  of  the  SKF  to  inaccuracies  in  the  filter 
parameters  such  as  the  stability  derivatives.   The  analysis 
has  been  performed  by  varying  each  of  the  flight  parameters 
over  a  given  range  and  noting  the  effect  on  the  accuracy  of 
the  filter.   The  great  advantage  of  the  analysis  in  the 
sensitivity  of  rms  estimate  errors  to  inaccuracies  in  the 
stability  derivatives  is  that  it  points  out  clearly  which 
derivatives  are  worthy  of  detailed  accurate  determination  and 
which  are  not. 


TABLE  OF  CONTENTS 

I.   INTRODUCTIOl^  -- -- ---  11 

II,   STOCHASTIC  MODELS  AND  ESTIMATION 13 

A.   A,   KALMAN  FILTER - ---  13 

1.  Linear  Dynamic  System 13 

2,  Continuous  Time  Kalman  Filter  14 

Bo   STATE  AUGMENTATION  AND  SHAPING  FILTERS  16 

Co   SENSITIVITY  TO  PARAMETER  VARIATION  17 

1.   Incorrect  Implementation  of  Dynamics  18 

Do   MODAL  COORDINATES  TRANSFORMATION  --  20 

E,   SOLUTION  OF  THE  KALMAN  FILTER  WITH  A  PRESCRIBED 

DEGREE  OF  STABILITY  -- - 21 

IIIo   DYNAMIC  AND  IffiASUREMENT  SYSTEM  MODELS  - 23 

Ao   REFERENCE  AXIS  SYSTEM 23 

B.   MISSILE  EQUATIONS  OF  MOTION 24 

1.  Longitudinal  Motion  24 

2,  Lateral  Motion 24 

Co   MODEL 25 

1,  Longitudinal  Motion  Estimation  25 

2.  Lateral  Motion  Estimation  27 

IV.   ANALYSIS 29 

A,   THE  SIMULATION 29 

Bo   THE  RESULTS 29 

1.  Longitudinal  Motion  Estimation  Analysis  30 

2.  Lateral  Motion  Estimation  Analysis  34 


5 


V.      CONCLUSIONS  AND  RECOmENDATIONS 77 

VI.      SUMMARY 81 

APPENDIX  A:   LIST  OF  SYMBOLS 83 

APPENDIX  B:   AERODYNA-MIC  DATA  AND  PROBABILISTIC 

INFORMATION  --- 85 

COMPUTER  OUTPUT  87 

COMPUTER  PROGRAM 95 

LIST  OF  REFERENCES 101 

INITIAL  DISTRIBUTION  LIST  102 


LIST  OF  FIGURES 


FIGURE  1: 
FIGURE  2: 

FIGURE  3: 

FIGURE  4: 
FIGURES  5; 6: 

FIGURES  7;8: 

FIGURES  9;1Q: 

FIGURES  11; 12: 

FIGURES  13; 14: 

FIGURES  15; 16: 
FIGURES  17; 18: 
FIGURES  19; 20: 
FIGURES  21; 22: 
FIGURES  23; 24: 
FIGURES  25; 26: 


System  Model  and  Kalman  Filter  14 

Shaping  Filter  Generating  Driving  Noise. 
Conformation  of  the  Augmented  System  17 

Block  Diagram  of  the  System  and  Kalman 
Filter  with  Incorrect  Implementation  of 
Dynamics  18 

Reference  Axis  System 23 

Sensitivity  of  u  and  H  rms  Estimate  Errors 
vs  Variation  in  Xu  stability  derivative  --  41 

Sensitivity  of  u  and  h  rms  Estimate  Errors 
vs  Variation  in  Xw  stabiltiy  derivative  --  42 

Sensitivity  of  u  and  w  rms  Estimate  Errors 
vs  Variation  in  Zw  Stability  Derivative  --  43 

Sensitivity  of  h  and  9  rms  Estimate  Errors 
vs  Variation  in  Zu  Stability  Derivative.--  44 

Sensitivity  of  wg  and  ug  rms  Estimate 
Errors  vs  Variation  of  Zu  Stability 
Derivative 45 

Sensitivity  of  u  and  w  rms  Estimate  Errors 
vs  Variation  in  Zw  Stability  Derivative  --  46 

Sensitivity  of  q  and  9  rms  Estimate  Errors 
vs  Variation  in  Zw  Stability  Derivative  --  47 

Sensitivity  of  h  and  u^  rms  Estimate  Errors 
vs  Variation  in  Zw  StaSility  Derivative  --  48 

Sensitivity  of  u  and  w  rms  Estimate  Errors 
vs  Variation  in  Mu  Stability  Derivative.--  49 

Sensitivity  of  9  and  h  rms  Estimate  Errors 
vs  Variation  in  Mu  Stability  Derivative  --  50 

Sensitivity  of  Wg  and  Uo   rms  Estimate 
Errors  vs  Variation  in  m  Stability 
Derivative 51 


FIGURES 

27: 

;28 

FIGURES 

29; 

;30 

FIGURES 

31: 

;32 

FIGURES 

33; 

;34 

FIGURES 

35; 

;36 

FIGURES 

37; 

;38 

FIGURES 

39; 

;40 

FIGURES 

41; 

;42 

FIGURES 

43; 

;44 

FIGURES 

45; 

;46 

FIGURES 

47; 

;48 

FIGURES 

49; 

;50 

FIGURES 

51; 

;52 

FIGURES 

53; 

;54 

FIGURES 

55; 

;56 

FIGURES 

57; 

:58 

FIGURES 

59; 

;60 

Sensitivity  of  u  and  w  rms  Estimate  Errors 
vs  Variation  in  Mw  Stability  Derivative  --  52 

Sensitivity  of  q  and  9  rms  Estimate  Errors 
vs  Variation  in  Mw  Stability  Derivative  --  53 

Sensitivity  of  h  and  Wg  rms  Estimate  Errors 
vs  Variation  in  Mw  Stability  Derivative  --  54 

Sensitivity  of  u  and  h  rms  Estimate  Errors 
vs  Variation  in  Mq  Stability  Derivative  --  55 

Sensitivity  of  u  and  w   rms  Estimate  Errors 
vs  Variation  in  M^  Stability  Derivative  --  56 

Sensitivity  of  q  and  9  rms  Estimate  Errors 
vs  Variation  in  M^Sr  Stability  Derivative  --  57 

Sensitivity  of  h  and  w^  rms  Estimate  Errors 
vs  Variation  of  Mx^^  Stability  Derivative  --  58 

Sensitivity  of  Vy  amd  p  rms  Estimate  Errors 
vs  Variation  in  iv  Stability  Derivative  --  59 

Sensitivity  of  9  and  Vgg  rms  Estimate  Errors 
vs  Variation  in  Yv  Stability  Derivative  --  60 

Sensitivity  of  Vg  and  r  rms  Estimate  Errors 
vs  Variation  in  N^  Stability  Derivative  --  61 

Sensitivity  of  p  and  9  rms  Estimate  Errors 
vs  Variation  of  N'  Stability  Derivative  --  62 

Sensitivity  of  if  and  Vgg  rms  Estimate  Errors 
vs  Variation  in  N'  Stability  Derivative  --  63 

Sensitivity  of  Vg  and  r  rms  Estimate  Errors 
vs  Variation  in  N'  Stability  Derivative  --  64 

Sensitivity  of  9  and  V  g  rms  Estimate  Errors 

vs  Variation  in  N'  Stability  Derivative  --  65 

r         -^ 

Sensitivity  of  Vg  and  r  rms  Estimate  Errors 

vs  Variation  in  N'  Stability  Derivative  --  66 

P         ^ 

Sensitivity  of  p  and  9  rms  Estimate  Errors 
vs  Variation  of  N'  Stability  Derivative  --  67 

Sensitivity  of  i)   and  Vgg  rms  Estimate  Errors 
vs  Variation  in  N'  Stability  Derivative  --  68 


FIGURES  61; 62: 
FIGURES  63; 64: 
FIGURES  65; 66: 
FIGURES  67; 68: 
FIGURES  69; 70: 
FIGURES  71; 72: 
FIGURES  73; 74: 
FIGURES  75; 76: 


Sensitivity  of  Vg  and  r  rms  Estimate  Errors 
vs  Variation  in  L'  Stability  Derivative  69 

Sensitivity  of  p  and  9  rms  Estimate  Errors 

vs  Variation  in  L'  Stability  Derivative  70 

p 

Sensitivity  of  i)   and  V3g  rms  Estimate  Errors 
vs  Variation  in  L'  Stability  Derivative  71 

Sensitivity  of  Vl  and  r  rms  Estimate  Errors 
vs  Variation  of  L'  Stability  Derivative  72 

Sensitivity  of  p  and  9  rms  Estimate  Errors 

vs  Variation  of  L'  Stability  Derivative  73 

Sensitivity  of  4)  and  Vgg  rms  Estimate  Errors 

vs  Variation  of  L*  Stabilitv  Derivative  74 

r 

Sensitivity  of  V3  and  r  rms  Estimate  Errors 

vs  Variation  in  L'  Stability  Derivative  75 

P 

Sensitivity  of  9  and  Vgg  rms  Estimate  Errors 

vs  Variation  in  L'  Stability  Derivative  76 

P 


ACKNQWLEDGEMEITT 

I  would  like  to  express  my  gratitude  to  Dr,  D,  J,  Collins 
for  his  assistance,  guidance  and  continuous  encouragement 
which  he  provided  during  the  pursuit  of  this  study.   To  my 
wife  I  would  like  to  offer  my  thanks  and  love  for  her  patience, 
understanding  and  fortitude  during  a  time  which  tested  both 
of  us  , 

JOSE  A  MATALLANA 


10 


I,   INTRODUCTION 

In  a  typical  tactical  missile  trajectory,  standoff  (or 
mid-course)  guidance  is  required  when  the  missile  is  launched 
at  such  long  ranges  from  the  target  that  either  the  missile 
seeker  cannot  detect  the  target  or,  if  it  can,  the  information 
is  of  such  poor  quality  that  is  unusable.   The  mid-course 
guidance  law  usually  consists  of  some  pre-programed  strategy 
such  as  to  maintain  the  launch  heading,  constant  altitude 
and  speed.   Mid-course  guidance  is  primarily  an  inertial 
instrumentation  problem.   Typical  sensors  onboard  missiles 
consist  of  three  rate  gyros  (pitch,  yaw  and  roll),  accelero- 
meters ,  sometimes  magnetic  compass  and  some  kind  of  altimeter. 
Additional  state  information  can  be  provided  by  the  seeker. 
A  radar  seeker  could  provide  range  and  range  rate. 

Here  is  considered  the  problem  of  using  steady-state 
Kalman  Filters  as  part  of  a  navigation  system,  where  the  two 
estimators  together  (longitudinal  and  lateral  estimators), 
constitute  a  strapdown  system  that  does  not  use  accelero- 
meters  or  gimbaled  gyros.   Strapdown  Inertial  Navigation 
Systems  (INS)  using  Steady-State  Kalman  Filters  (SKF)  as 
estimators  have  been  considered  as  cheaper  and  easier  to 
implement  than  the  gimbaled  INS,   The  sensors  used  in  this 
analysis  are:   pitch  and  roll  rate  gyros,  altimeter  and  mag- 
netic compass.   Since  constant  gain  estimators  have  been 
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suggested  as  easier  and  cheaper  to  implement,  the  analysis  is 
confined  to  the  SKF, 

This  work  has  been  motivated  by  the  idea  given  in  Ref . 
II4IIs  where  the  author  discusses  in  detail  the  configuration' 
of  such  a  navigation  system  as  described  before,  but  the 
problem  is  presented  as  a  particular  application  in  the  INS 
of  the  DC-8  airplane.   For  convenience  the  model  used  here 
essentially  is  the  same  as  Ref,  [4^  in  lieu  of  a  missile. 
This  was  done  in  order  to  eliminate  classification  problems. 

This  thesis  investigates  only  one  aspect  of  the  INS 
problem.   That  aspect  is  the  sensitivity  of  the  Kalman  Filter 
to  inaccuracies  in  the  filter  parameters  or  variation  between 
the  filter  model  and  the  plant  model.   These  differences  can 
be  due  to  either  inaccuracies  as  indicated  or  to  a  normal 
variation  in  the  flight  parameters  due  to  different  flight 
regimes.   One  result  of  this  is  the  sensitivity  of  rms 
estimate  errors  to  inaccuracies  or  differences  in  the  sta- 
bility derivatives. 

The  work  was  begun  by  reproducing  the  results  given  in 
Ref .  [41]  with  the  correct  implementation  of  the  dynamics  in 
the  filter  parameters  (i.e.,  Xu,  Yv,  etc.)  over  a  given 
range  and  noting  the  effect  on  the  accuracy  of  the  filter. 
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II,   STOCHASTIC  MODELS  AND  ESTIMATION 

A.   KALMAN  FILTER 

The  Kalman  Filter  is  widely  documented  and  no  attempt  at 
a  development  of  general  theory  has  been  made  in  this  work. 
A  brief  description  has  been  included  in  order  to  establish 
the  particular  forraulation  used.   For  a  more  complete  de- 
velopment one  is  referred  to  Ref  [Il]]» 

1 ,   Linear  Dynamic  System 

The  formulation  used  employs  state-space  notation 
which  offers  the  advantage  of  mathematical  and  notational 
convenience.   Consider  the  linear  time  invariant  system 
(system  and  measurement  models)  given  by  equation  (1) ,  where 
X  represents  the  states  of  the  system;  z  is  the 

X  =  Fx  +  rw  (1-a) 

z  =  Hx  +  V  (1-b) 

measurement  vector;  F  is  the  system  matrix;  r  is  the  driving 
noise  coefficient  m^atrix;  H  describes  the  relationship  between 
the  states  and  the  measurement;  w  and  v  are  independent,  zero- 
mean  white  gaussian  noise  process  with  covariance  matrices  Q 
and  R  respectively,  that  in  mathematical  terms  are  given  by: 


E(w(t)w'^(T))  =  Q(t)6(t-T),  E(w(t))  =  0  (2-a) 

E(v(t)v'^(T))  =  R(t)5(t-T),  E(v(t))  =  0  (2-b) 
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2«   Continuous  Time  Kalman  Filter 

A  continuous  time  Kalman  Filter  is  described  by 
equation  (3) ,  where  x  is  the  state  estimate;  K  is  a  matrix  of 
constant  filter  gains.   The  implementation  of  the  System 
Model  and  the  Kalman  Filter  is  shown  in  block  diagram  in 
Figure  l. 


X  =  Fx  +  K(z-Hx) 


(3) 


MATHEMATICAL_MO]DEL 
SYSTEM 


MEASUREMENT 


w- 


KALMAN  FILTER 


'^        • 

j>> 

f 

F 

?^  ^ 

K     ■ 

1 

^^   ' 

- 

■     H 

_ 

X 


Figure  1 
System  Model  and  Kalman  Filter 
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The  estimate  error  is  defined  by  equation  (4)  as, 


~  A  - 

X  =  X  -  X 


(4) 


and  the  differential  equation  for  x  is  given  by 


X  =  (F-KH)x  -  rw  +  Kv 


(5) 


The  differential  equations  for  the  state  of  a  linear  system 
driven  by  white  noise  can  be  expressed  as 


1    "I 

"•      ■" 

F-KHI    0 

X 

\ 

— 

+ 

_   0      1   F_ 

_x_ 

Kv-rw 
rw 


(6) 


The  covariance  of  the  estimate-error,  designated  P,  is  given 
by  equation  (7) .   It  provides  a  statistical  measure  of  the 
uncertainty  in  x. 


P  =  ECxx*^] 


(7) 


The  diagonal  elements  of  the  covariance  matrix  are  the  mean 
square  errors  in  the  knowledge  of  the  state  variables.   Also, 
the  trace  of  P  is  the  mean  square  length  of  the  vector  x. 
The  off  diagonal  terms  of  P  are  indicators  of  cross-correlation 
between  the  elements  of  x.   The  covariance  matrix  P  is  obtained 
by  solving  the  linear  Lyapunov  equation  given  by 
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p  =  (F-KH)P  +  PCF-KH)"^  +  rgr"^  +  krk"^         (8) 

The  eigenvalues  of  the  filter  are  the  roots  of  equation  (9) . 

|SI  -  F  +  KH|  =0  (9) 

B.   STATE  AUGMENTATION  AND  SHAPING  FILTERS 

When  the  system  random  disturbances  are  correlated  in 
time,  i.e.,  colored  noise,  it  is  necessary 'to  use  their 
power  spectral  density  data  in  order  to  develop  a  mathematical 
model  that  produces  an  output  which  duplicates  the  noise 
characteristics  [Ref.  211,   Correlated  random  noises  are  taken 
to  be  state  variables  of  a  fictitious  linear  time  invariant 
system  (generally  called  a  shaping  filter)  which  is  itself 
excited  by  white  gaussian  noise.   Such  a  model  is  given  by 
equation  (10),  where  the  subscript  f,  denotes  filter  and  n, 
is  a  nonwhite,  i.e.,  time-correlated,  gaussian  noise.   The 
filter  output  is  used  to  drive  the  system  as  show  in  Fig,  2, 

^f  ^  "^f^f  "*"  ^f^  (10-a) 

n  =  H^x^  (10-b) 

The  dimension  of  the  state  vector  (1)  is  increased  by 
including  the  disturbances  as  well  as  a  description  of  the 
system  dynamics  behavior  in  appropriate  rows  of  an  enlarged 
F  matrix,  this  is  called  state  vector  augmentation. 
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Figure   2 

Shaping  filter  generating  driving  noise 
Conformation  of  the  Augmented  System. 


The  augmented  state  equation  is  given  by 


• 

X 

F 

1  ™fl 

X 

"o" 

-  - 

= 



-1 

— .  — 

+ 



rd 

_0 

!  ^2 

k 

L^fJ 

w 


(11) 


The  associated  measurement  equation  given  by  equation  (12) 


=  [h  I  oj 


X 


L^fJ 


+  V 


(12) 


C.   SENSITIVITY  TO  PARAMETER  VARIATION 

Observing  the  structure  of  the  Kalman  Filter  illustrated 
in  Figure  1;  the  filter  contains  an  exact  model  of  the  system 
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dynamics o   The  filter  gain  matrix  is  calculated  using  the 
parameters  of  the  exact  model  of  the  dynamics, 
1 .   Incorrect  Implementation  of  Dynamics 

The  analysis  of  how  the  error  covariance  behaves  when 
the  gain  matrix  is  computed  using  wrong  values  of  F  matrix, 
i.e.,  varying  parameters  due  to  different  flight  conditions, 
is  quite  well  explained  in  Reference  Hi].   Figure  3  shows  the 
block  diagram  for  the  system  model  and  the  Kalman  Filter, 
where  the  quantities  K"'^  and  F'='<"  represent  the  gain  matrix  and 
the  system  dynamics  implemented  in  the  filter. 


SYSTEM 


KALMAN  FILTER 


Figure  3 

Block  diagram  of  the  System  Model  and  Kalman 
Filter  with  incorrect  implementation  of  dynamics 
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The  equation  for  the  estimate  is  given  by 


X  =  F*x  +  K^^(z-Hx) 


(13) 


The  error  in  the  estimate  given  by  (14) 


X  =  (F*  -  K''^H)x  +  AFx  -  rw  +  K^'v 


(14) 


where 


/^F  =  F*  -  F 

The  differential  equations  for  the  states  of  a  linear  system 
driven  by  white  gaussian  noise  given  previously  by  equation 
(6)  becomes  now 


X 

F*   -   K*H   1     AF 

1 

X 

K*v  -  rw 



= 

J 

— 

+ 



x_ 

_       0             1      F_ 

X 

rw 

(15) 


A  r-1 

Letting  x'  be  the  augmented  state  vector,  x'  = , 

where  the  covariance  matrix  of  x'  is  given  by: 


,T.    \_i 


E(x'x'^) 


V   U 


(16) 


where 
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P  =  ECScx"^),  V  =  E(xx^),  U  ^  ECxx"^) 


The  quantity  of  interest  is  P,  the  covariance  of  x. 
The  error  sensitivity  equations  are  given  by 


P  =  (F*  -  K-^R)?  +  ?(T*   -  K^H)*^  +  AFV 

rpm  rn  rp  ^J./""a/ 

+  V^AF^  +  ror   +  K^'RK*^ 


V  =  FV  +  V(F^'  -  K^H)*^  +  UAF*^  -  rQr"^  (17-b) 


u  =  Fu  +  UF*^  +  rgr"^  (i7-c) 


with  initial  conditions 


P(0)  =  -V(0)  =  U(0)  =  E(x(O)x(0)'^) 


when  the  actual  system  dynamics  are  faithfully  reproduced  in 
the  filter,  i.e.,  F  =  F*,  AF  =  0,  the  equation  (17)  reduces 
to  the  linear  Lyapunov  equation  given  by  equation  (8) . 

Do   MODAL  COORDINATES  TRANSFORMATION 

The  representation  of  the  system  given  by  equation  (1)  is 
not  unique.   Considering  an  alternative  linear  transformation 
of  the  states  given  in  references  [3]  and  [14]  ,  let  x  =  T^, 
where  C  represents  the  transformation  of  the  states  and  T  is 
the  transformation  matrix  with  the  columns  formed  by  the 
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eigenvectors  of  the  system  matrix  F  (for  a  complex  eigenvalue, 
the  first  coliomn  is  the  real  part  and  the  second  column  is 
the  imaginary  part  of  the  eigenvector) .   The  similarity 
transformation  of  equation  (1)  is  given  by 

C  =  AC  +  Bw  (18-a) 

z  =  CC  +  V  (IS-b) 


where 


A  =  T"^FT,  B  =  T'^r,  C  =  HT 

A  case  of  particular  interest  (canonical  form)  occurs 
when  the  resulting  A  matrix  is  diagonal  (the  eigenvalues  of 
the  F  matrix  form  the  diagonal).  The  design  of  the  estimator 
in  modal  coordinates  is  analogous  to  using  transfer  functions 
in  partial  fraction  form.  The  canonical  form  is  more  inform- 
ative than  the  transfer  frunction  method,  since  observability 
and  controllability  can  be  obtained  by  inspection. 

E.   SOLUTION  OF  THE  KALMAN  FILTER  WITH  A  PRESCRIBED  DEGREE 
OF  STABILITY 

The  Kalman  Filter  designed  with  constant  gain  (SKF)  and 
used  as  an  observer  will  diverge  if  there  are  undisturbed, 
neutrally  stable  (UNS)  modes  in  the  system  model.   In  refer- 
ences C4]  and  Z51   the  authors  presented  the  idea  of 

) 
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destabilization  of  the  system  model  (1) ,  the  amount  of  de- 
stabilization  can  be  varied  until  the  resulting  suboptimal 
observer  has  a  specified  degree  of  stability.   The  method 
presented  in  Ref ,  C4]  refers  only  to  destabilizing  the  UNS 
modes  in  the  system  model,  that  method  is  called  "modal 
destabilization"  (MDS) .   The  gains  of  the  filter  are  con- 
strained so  that 

Re(Si)  -  -a,  i  =  1,2, n  (19) 

where  Re  (Si)  indicates  "real  part  of  (Si),"  Si,.,..Sn  are 
the  eigenvalues  of  the  filter,  i,e,,  the  roots  of  equation 
(9)  and  a  is  a  specified  positive  nxmiber. 

The  original  system  is  destabilized  in  accordance  with 
equation  (20),  where  F'  is  the  resultant  destabilized  matrix, 
E  the  destabilization  matrix  (diagonal)  and  T  is  the  modal 
transformation  matrix  (eigenvector  matrix).   The  matrix  F'  is 
used  in  order  to  calculate  the  modified  gains  of  the  filter 
(suboptimal  gains) , 

F'  =  F  +  TET"^  (20) 

This  method  avoids  the  divergence  of  the  steady-state 
Kalman  Filter  with  a  slight  decrease  in  estimation  accuracy. 
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Ill,   DYNAMIC  AND  MEASUREMENT  SYSTEM  MODELS 

A.   REFERENCE  AXIS  SYSTEM 

The  Reference  Axis  System  in  a  missile  is  centered  on  the 

e.g.  and  fixed  on  the  body  as  follows: 

X  axis,  called  the  roll  axis,  forwards,  along 
the  axis  of  symmetry. 

Y  axis,  called  the  pitch  axis,  outwards  and  to 
the  right  if  viewing  the  missile  from  behind, 

Z  axis,  called  the  yaw  axis,  downwards  in  the 
plane  of  symmetry  to  form  a  right-handed 
orthogonal  system  with  the  other  two. 

The  s3mibols  from  Appendix  A  define  the  forces  and  moments 

acting  on  the  missile,  the  linear  and  angular  velocities,  and 

the  moments  of  inertia;  those  quantities  are  shown  in  Figure 

4, 


X.V,u 


Relative  Wind 


Figure  4 
Reference  Axis  System 
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B.   MISSILE  EQUATIONS  OF  MOTION 

The  equations  of  motion  used  in  the  present  study  in  order 
to  represent  the  missile  dynamics  are  quite  well  defined  in 
Reference  C7I].  A  linear  dynamical  model  of  the  missile  based 
on  the  rigid  body  approximation  is  appropriate. 

1.   Longitudinal  Motion 

The  longitudinal  motions  of  a  missile  are  modeled  by 
a  fifth-order  system  given  by  equation  (21) ,  where  the  state 
variables  are  u,  velocity  along  the  X  axis;  w,  velocity  along 
the  Z  axis;  q,  pitch  rate,  B,  pitch  angle  and  h,  altitude. 


'n' 

Xw 

Xw 

0 

-g 

0 

u 

^ 

Zw 

Zw 

V 

0 

0 

w 

4 

= 

Mu+MwZu 

Mw+MwZw 

Mq+MwV 

0 

0 

q 

9 

0 

0 

1 

0 

0 

9 

_^_ 

0 

-1 

0 

V 

0_ 

_h 

(21) 


2.   Lateral  Motion 

The  lateral  motions  of  a  missile  are  modeled  by  a 
fifth-order  system  given  by  equation  (22)  ,  where  the  state 
variables  defined  are;  6  sideslip  angle;  r  yaw  rate;  p  roll 
rate;  tj)  roll  angle;  4;  heading  angle. 
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C .   MODEL 

The  aerodynamic  data  used  in  the  present  study  is  given 
in  Appendix  B  [Ref  91],   Essentially  the  models  and  noise 
dynamics  are  those  of  reference  C^]. 

1,   Longitudinal  Motion  Estimation 

The  main  disturbance  inputs  are  the  two  wind  velo- 
cities u  and  w  .   Under  the  particular  flight  conditions, 

o         5 

the  turbulance  represented  by  the  fluctuating  parts  of  u^  and 
Wg  are  color  noise.   They  are  modeled  by  first-order  shaping 
filters  with  white  gaussian  noise  inputs  as  given  in  equation 
(10) .   The  resultant  linear  model  is  given  by  equation  (23) 
CRef  8:. 


u 


g 


w 


LgJ 


-0.413 


0 


-0.853 


u. 


w. 


+ 


0.413     0 
0     0.853 


u 


L^W. 


(23) 


The  numerical  data  for  the  longitudinal  dimensional 
derivatives  was  used  in  equation  (21)  ,  the  resultant  model  is 
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given  by  equation  (24) ,  that  corresponds  to  the  state  vector 

augmentation  given  by  equation  (11) .   Units  are  scaled  with 

u,  w,  u  and  w  in  units  of  10  ft/s,  q  in  units  of  0.01  rad/s. 
S      g 


u 
w 

q 

o 

9 
h 

• 

c 


■0.015  0.004  0         -0.0322     0 

■0.074  -0.806  0.824            0 

■0.749  -10.7  -1.344          0 

0              0  10 

0  -0.1  0         0.0824       0 

0             0  0  0 

0             0  0  0 


0 
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0.004 

0 

-0.074 
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0.749 
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0 

0 

0 

0 

0 

0 

-0.413 

0 

0 

0 
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w 


_aj 


0  0 

0  0 

0  0 

0  0 

0  0 

0.413  0 

0  0.853 

(24) 


'u 


L^^wj 


9  in  units  of  0.01  rad. ,  and  h  in  units  of  100  ft. 

The  measurement  model  given  by  equation  (25)  assumes 
a  rate  gyro  in  order  to  measure  z  and  a  barometric  altimeter 
in  order  to  measure  z,. 


0   0   10   0   0   0 


0   0   0   0   10   0 
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L"gJ 
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L^hJ 


(25) 
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2.   Lateral  tlotion  Estimation 

The  main  disturbance  input  is  lateral  wind  v^.   The 
turbulence  represented  by  the  fluctuating  part  of  v  is  color 
noise,  it  is  modeled  as  a  first-order  shaping  filter  with 
white  gaussian  noise  input  as  given  in  equation  (10) .   The 
resulting  shaping  filter  is  as  given  by  equation  (26)  and 
taken  from  Reference  1141, 


where 


e   =  -0,853e  +  0.853y 


g   g/v 


(26) 


The  numerical  data  for  the  lateral  dimensional  derivatives 
was  used  in  equation  (22)  to  obtain  the  equation  (27) ,   This 
corresponds  to  the  state  vector  augmentation  given  by 
equation  (11) . 
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The  measurement  model  given  by  equation  (28) ,  represents  the 
situation  where  the  measurement  Zp  is  taking  with  a  roll-rate 
gyro  and  the  measurement  z^  using  a  magnetic  compass. 


P 
5^- 


0   0   10   0   0 
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r 
P 

+ 

1  0  ' 
_0  1 

(28) 
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IV,      ANALYSIS 

A.  THE  SIMULATION 

A  computer  program  was  developed  in  order  to  solve  the 
sensitivity  equations  given  by  equation  (17) .   Basically,  the 
program  was  used  to  handle  a  set  of  105  linear  differential 
equations  in  the  longitudinal  case  and  78  in  the  lateral. 
The  principle  program  output  is  the  time  history  of  the  P 
matrix  and  the  square  root  of  its  diagonal  elements  (the  rms 
estimate  errors) , 

The  Kalman  Filter  computer  program  was  the  primary  tool 
used  in  computing  the  gains.   The  program  was  developed  at 
the  Massachusetts  Institute  of  Technology  CRef.  lOH  and 
adapted  for  use  at  the  Naval  Postgraduate  School,   A  second 
computer  program  composed  at  Stanford  University,  OPTSYS  4 
Computer  Program  [Ref,  11],  which  utilizes  several  options  of 
the  Kalman  Filter,  was  also  implemented  in  this  analysis.   In 
particular,  the  suboptimal  filter  using  the  modal  destabili- 
zation  (MDS)  design  option  was  required  for  the  lateral  case. 

B.  THE  RESULTS 

As  the  problem  is  described,  the  results  are  presented  in 
two  parts,  the  longitudinal  and  the  lateral  case. 

Initially  both  models  given  by  equations  (24)  and  (27) 
were  modified  in  order  to  include  another  state  in  each  of 
them,  the  perturbed  position.   The  resultant  observers  were 

29 


tested,  but  in  both  cases  they  were  unstable, 
1,   Longitudinal  Motion  Estimation  Analysis 

A  steady-state  Kalman  Filter  was  designed  [Ref ,  4] 
and  used  as  a  constant  gain  state  estimator  (equation  (3)), 

The  first  step  in  this  analysis  was  to  reproduce  the 
results  for  the  case  of  exact  implementation  of  dynamics  in 
the  calculation  of  the  Kalman  gain  matrix.   That  analysis  was 
done  using  the  MoI.T.  Kalman  Filter  Computer  Program  [Ref,  10] 
The  results  are  shown  below: 

Filter  gain  matrix  K. 


0,059 

0,060 

0,264 

-0.161 

3,517 

0.040 

0.001 

-0.080 

0,013 

0.136 

0,011 

0,035 

1.288 

0,128 

Filter  Eigenvalues 

-0,310 

+ 

JO, 

,411 

-0.429 

-0.178 

-0,261 

-0.063 

+ 

JO 

.0743 

rms  estimate  errors 
u  =  2.090  ft/s        e  =  0.317  deg 
w  =  5.102  ft/s        h  =  8,245  ft 
q  =  0.416  deg/s      ug  =  4.776  ft/s 

Wg  =  5.701  ft/s 
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These  results  are  essentially  identical  to  those  of  Ref.  [4^. 

The  next  objective  was  to  consider  the  incorrect 
implementation  of  dynamics  in  the  Kalman  Filter,  in  order  to 
study  the  sensitivity  of  rms  estimate  errors  to  inaccuracies 
in  the  stability  derivatives.   The  numerical  variation  of  the 
parameters  were  considered  individually  in  order  to  establish 
the  F*  matrix  to  be  used  in  equation  (17)  and  also  for  finding 
the  filter  gain  matrix  K*  to  be  implemented  in  the  same 
equation.   For  each  variation  of  the  parameter  under  obser- 
vation it  was  necessary  to  run  the  M<.I,T,  Computer  Program 
CRef ,  ion  in  order  to  find  the  matrix  of  gains  K"^  and  then  to 
rtin  the  sensitivity  covariance  program  in  order  to  study  the 
propagation  of  the  estimate  errors. 

The  results  are  shown  in  Tables  1-8  and  Figures  5-40. 
In  the  Tables,  the  true  value  of  each  parameter  is  marked  with 
an  asterisk.   The  description  of  the  results  are: 

Xu.   The  dimensional  variation  of  X  force  with  forward 
speed  (u)  has  a  nominal  value  of  -0.015.   This  quantity  was 
changed  in  a  range  of  +20%.   The  behavior  of  the  rms  estimate 
errors  are  presented  in  Table  1«   From  that  it  can  be  seen 
that  any  numerical  variation  of  Xu  derivative  does  not  cause 
significant  changes  in  the  nominal  values  of  the  rms  estimate 
errors  of  the  states,  w,  q,  9,  u^  and  w  .   For  the  states 
u  and  h  the  results  are  shown  in  Figures  5-6  respectively, 
with  some  effect,  but  not  significant  for  positive  variation 
of  Xu. 
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Xw.   The  dimensional  variation  of  X  force  with  down- 
ward speed  (w)  has  a  nominal  value  of  0.004.   As  before,  the 
numerical  variation  was  performed  in  a  range  of  +207oo   The 
behavior  of  the  rms  estimate  errors  were  tabulated  in  Table 
2,   Checking  the  results  there  is  no  variation  in  the  nominal 
values  of  rms  estimate  errors  of  the  states,  w,  q,  9,  Ug  and 
Vct>  for  any  of  the  changes  made  in  Xw  derivative.   The  vari- 
ations  in  the  estimate  errors  for  u  and  h  are  indicated  in 
Figures  7  and  8  respectively.   Increasing  the  value  of  Xw  the 
u  error  decreases  but  h  increases,  while  taking  smaller  values 
of  the  parameter,  the  effect  is  contrary.   Those  changes  in 
the  rms  errors  are  considered  not  important, 

Zu.   The  dimensional  variation  of  Z  force  caused  by 
a  change  in  forward  speed  (u)  has  a  nominal  value  of  -0.074. 
The  effects  of  changing  its  design  value  was  observed  in  a 
range  of  20%  and  its  result  condensed  in  Table  3  as  well  as 
in  Figures  9-14.   All  the  rms  errors  show  some  degree  of 
sensitivity  except  q.   The  most  important  changes  occur  in 
u,  9,  and  h  errors  and  the  large  variation  in  u  can  begin  to 
be  important  in  terms  of  accuracy  in  radial  position, 

Zw.   The  dimensional  variation  of  Z  force  with  down- 
ward speed  (w)  has  a  nominal  value  of  -0.806.   The  results 
for  this  case  are  presented  in  Table  4  and  Figures  15-20, 
Again,  the  variation  in  the  value  of  Zw  was  made  in  a  range 
of  +207o.  .  All  the  rms  estimate  errors  show  a  large  degree  of 
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sensitivity  and  it  can  be  considered  that  any  numerical  vari- 
ation of  Zw  beyond  +  TL   is  critical  and  unacceptable, 

MUo   The  dimensional  variation  of  M  moment  caused  by 
a  change  in  forward  speed  (u)  has  a  nominal  value  of  -0,000786 
The  value  of  Mu  was  changed  in  a  range  of  IQTL   and  the  results 
are  given  in  Table  5  as  well  as  Figures  21-26.   Any  variation 
in  Mu  quantity  does  not  cause  important  changes  in  the  value 
of  the  rms  estimate  errors  of  the  states,  q,  Ug  and  w„.   For 
For  the  states  u,  w,  9,  and  h,  the  variation  in  the  errors 
can  be  considered  with  some  significant  effect  for  large 
deviations  of  Mu  value,  i,e.,  more  than  +10%. 

Mw,   The  dimensional  variation  of  M  moment  with  speed 
(w)  has  a  nominal  value  of  -0,0111.   Its  numerical  variation 
was  taken  in  a  range  of  +10%.   From  Table  6  and  Figures  27-32, 
it  can  be  seen  that  any  alteration  in  the  true  value  of  Mw  is 
reflected  with  a  strong  effect  on  all  the  rms  estimate  errors. 
This  derivative  can  be  considered  the  most  critical  in  the 
longitudinal  motion  estimation  case. 

Mq.   The  dimensional  variation  of  pitching  moment  with 
pitch  rate  (q)  has  a  nominal  value  of  -0.924.   The  results 
are  given  in  Table  7  and  Figures  33  and  34  for  a  range  of 
+20%  in  the  numerical  variation  of  Mq,   The  sensitivity  of  the 
rms  estimate  errors  due  to  changes  in  this  parameter  is  min- 
imum for  all  the  states. 
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Mw,   The  dimensional  variation  of  pitching  moment 
with  rate  of  change  of  downward  speed  (w)  has  a  nominal  value 
of  -0. 00051 o   Table  8  and  Figures  35-40  presents  the  infor- 
mation about  the  changes  of  the  rms  estimate  errors  in  a 
range  of  +20%  in  the  variation  of  Mw  derivative.   All  the 
errors  show  some  degree  of  sensitivity  and  with  more  than  +2% 
in  the  alteration  of  the  Mw  value,  the  variation  in  the  errors 
begins  to  be  significant. 

2.   Lateral  Motion  Estimation  Analysis 

The  dynamic  system  (equation  (27))  and  measurement 
models  (equation  (28))  were  transformed  into  modal  coordin- 
ates in  accordance  with  equation  (18) .   This  was  done  using 
the  OPTSYS  4  Computer  Program  [Ref,  11];  the  results  are 
given  below: 
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These  results  are  identical  to  those  given  in  Ref, 
[4].   In  the  same  reference  the  author  gives  a  complete 
analysis  of  controllability  and  observability  using  the  re- 
sults given  in  equations  (29)  and  (30)  .   From  these  can  be 
seen  that  the  spiral  mode  ^S  has  its  eigenvalue  close  to  the 
origin  and  it  is  almost  undisturbed  by  the  process  noise;  also 
it  is  unobservable  with  the  measurement  z^.   Using  a  steady- 
state  Kalman  Filter  as  an  observer  fail  to  estimate  the 
heading  mode  ^H  and  its  estimation  of  the  spiral  mode  ?S  is 
too  slow.   The  next  objective  was  to  take  the  SKF  and  to  con- 
sider the  situation  of  parameter  variations  in  the  dynamic 
implemented  in  the  filter.   With  the  true  values  of  the  F 
matrix  implemented  in  the  filter  the  results  are  shown  below: 

Filter  Gain  Matrix  K 


0.051 

-0,967 

-1,536 

0.411 

2.695 

-0,004 

0.386 

-0,789 

-0.005 

0,906 

-1.713 

0.655 
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Filter  Eigenvalues 

-2,350  +  J2.594 
-0,624  +  j0,492 
-0.00125 
0,0 

rms  Estimate  Errors 

V6  =  3,329  ft/s 

r  =  0.244  deg/s 

p  =  0,377  deg/s 

i  =  0.222  deg 

ip  =  0.214  deg 

VSg  =  5,506  ft/s 

These  results  are  essentially  identical  to  those 
from  Ref.  [411.   The  filter  was  found  to  be  stable  but  with  a 
narrow  margin  of  stability.   Any  attempt  to  change  parameters 
resulted  in  a  failure  of  the  estimator  due  to  divergence  with 
the  most  minimum  variation  (i.e.,  +17o)  of  any  of  the  para- 
meters.  This  result  complements  the  analysis  given  previously 
HRef,  4]  and  it  shows  definitely  that  it  is  impossible  to  use 
the  SKF  as  an  estimator  for  the  lateral  motion  with  the  actual 
configuration  of  the  model  given  by  equations  (27)  and  (28) . 

The  alternative  solution  was  to  design  a  suboptimal 
observer  (MDS)  with  the  constrain  (19)  as  given  in  Ref.  [4^, 
a  =   0.029  and  using  equation  (20)  in  the  MDS  option  the 
computer  program  OPTSYS  4  [Ref,  11],   The  results  are: 
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Filter  Gain  Matrix  K 


-0.073 

-0.871 

-1.560 

0.430 

2.731 

-0,033 

0.339 

-0.753 

-0.033 

0.928 

-1.622 

0.585 

Filter 

Eigenvalues 

-2.350  +  J2.589 

-0.624  +  jO.492 

-0.0291  +  jO.005 

rms  Estimate  Errors 

Ve  =  3.799  ft/s 

r  =  0.245  deg/s 

p  =  0.379  deg/s 

5  =  0.226  deg 

\i)   =  0.216  deg 

VBg  =  5,712  ft/s 

These  results  are  essentially  identical  to  those 
from  Ref.  [4]. 

The  sensitivity  of  the  lateral  rms  estimate  errors 
due  to  inaccuracies  in  the  stability  derivatives  was  studied 
using  the  suboptimal  filter  (MDS)  design  and  following  the 
same  procedure  explained  before  for  the  longitudinal  case. 
The  results  are  shown  in  Tables  9-15  and  Figures  41-76.   The 
results  are  described  in  detail  as  follows: 
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YVo   The  dimensional  variation  of  Y  force  with  side 
velocity  (v)  has  a  nominal  value  of  -„0868o   This  value  was 
changed  in  a  range  of  +20%  and  the  results  appear  in  Table  9 
and  Figures  41-44.   r,  p,  ^,    and  V6g  show  almost  no  sensi- 
tivity to  the  variation  in  Yv  parameter,  VB  changes  but  it 
can  be  considered  of  secondary  importance.   The  most  sensi- 
tivity change  occurs  in  <^   and  it  begins  to  be  important  for  a 
variation  of  +57o  in  Yv  value. 

N ' ,   The  dimensional  variation  of  yawing  moment  about 
Z  axis  with  sideslip  angle  (8)  has  a  nominal  value  of  2.14. 
Table  10  and  Figures  45-50  give  the  results  for  a  variation 

of  N'  derivative  in  a  range  of  +10%.   All  the  rms  estimate 

p 

errors  except  \l)   present  strong  sensitivity,  especially  VS 
and  ^.   With  a  variation  of  more  than  +1%,  the  estimation  of 
these  errors  begin  to  show  large  values  and  the  filter  takes 
a  long  time  to  reach  the  steady  state  value  (more  than  150  s) , 
For  that  reason,  any  variation  in  the  true  value  of  N'  with 
the  purpose  of  implementation  in  a  Kalman  Filter  as  an  esti- 
mator must  be  considered  unacceptable, 

N^.   The  dimensional  variation  of  yawing  moment  about 
Z  axis  with  yaw  rate  (r)  has  a  nominal  value  of  -0.228.   In 
a  range  of  +20%  the  variation  of  N^  value  was  performed  and 
the  results  tabulated  in  Table  11  as  well  as  the  important 
variations  registered  in  Figures  51-54.   The  effects  on 
sensitivity  of  all  the  rms  estimate  errors  are  secondary  and 
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there  is  no  important  alteration  in  their  values  due  to  large 
variations  in  the  N^^  parameter. 

N^.   The  dimensional  variation  of  yawing  moment  about 
Z  axis  with  roll  rate  (p)  has  a  nominal  value  of  -0,0204. 
This  number  was  changed  in  a  range  of  4-20%  and  the  results 
observed  are  given  in  Table  12  and  Figures  55-60.   r,  p,  \p , 
and  V6g  rms  errors  do  not  present  any  important  variation. 
The  sensitivity  in  rms  estimate  error  is  observed  in  Vg  and 
cf) ,  in  particular.   For  the  last  one,  the  change  is  too  large 
for  a  variation  of  5%  in  the  value  of  the  parameter, 

L^ .   The  dimensional  variation  of  rolling  moment 
about  X  axis  with  sideslip  angle  (S)  has  a  nominal  value  of 
-4.41.   Its  variation  was  given  just  in  a  margin  of  +10%  be- 
cause with  larger  changes  the  estimator  starts  to  diverge. 
The  results  obtained  are  given  in  Table  13  and  Figures  60-66. 
All  the  rms  estimate  errors  show  some  degree  of  sensitivity 
due  to  the  variation  in  Lg  parameter  and  with  1%  of  change 
some  of  the  errors  like  V3'  and  ^  present  very  large  vari- 
ations.  For  that  reason  this  derivative  must  be  considered 
critical  in  the  implementation  of  the  Kalman  Filter  as  an 
estimator. 

Lr.   The  dimensional  variation  of  rolling  moment 
about  X  axis  with  yaw  rate  (r)  has  a  nominal  value  of  -0.334, 
The  results  presented  in  Table  14  and  Figures  67-72  are  the 
product  of  the  observation  for  the  variation  of  the  parameter 
L^   in  a  range  of  +10%  and  it  can  be  considered  as  the  most 
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important  stability  derivative  for  the  lateral  model,  because 
the  dynamics  implemented  in  the  filter  does  not  allow  any 
variation  of  its  true  value,  otherwise,  the  estimation  of  the 
errors  becomes  to  be  too  large  and  probably  the  filter  can 
diverge.   In  other  words,  the  sensitivity  of  the  estimator 
to  any  variation  in  L;^  value  is  extremely  critical. 

L^o   The  dimensional  variation  of  rolling  moment 
about  X  axis  with  roll  rate  has  a  nominal  value  of  -1.204, 
The  behavior  of  the  rms  estimate  errors  were  observed  taking 
a  variation  of  +107o  of  the  L^  parameter  and  they  are  given 
in  Table  15  and  Figures  73-76.   V3  and  r  are  the  variables 
that  present  some  degree  of  sensitivity  in  the  increment  of 
their  rms  estimate  errors,  respectively,  and  they  begin  to  be 
important  with  a  variation  of  more  than  +5%  of  the  L^  true 
value . 
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Figures  5  &  6.   Sensitivity  of  u  and  h  rms  estimate  errors  vs 
variation  in  Xu  stability  derivative 
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Figures  7  &  8.  Sinsitivity  of  u  and  h  rms  estimate  errors  vs 
variation  in  Xw  stability  derivative. 
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Figures  9  &  10.   Sensitivity  of  u  and  w  rms  estimate  errors  vs 
variation  in  Zu  stability  derivative. 
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Figures  11  &  12.   Sensitivity  of  h  and  9  rms  estimate  errors  vs 

variation  in  Zu  stability  derivative. 
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Figures  13  &  14.   Sensitivity  of  Wg  and  Ug  rms  estimate  errors  vs 

variation  of  Zu  stability  derivative. 
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Figures  15  &  16.   Sensitivity  of  u  and  w  rms  estimate  errors  vs 

variation  in  Zw  stability  derivative. 
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Figures  17  &  18.   Sensitivity  of  q  and  g  rms  estimate  errors  vs 

variation  in  Zw  stability  derivative. 
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Figures   19   &  20.      Sensitivity  of  h  and  u^,  rms  estimate  errors  vs 

variation  in  Zw  stability  derivative. 
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Figures  21  &  22.   Sensitivity  of  u  and  w  rms  estimate  errors  vs 

variation  in  Mu  stability  derivate. 
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Figures  23  &  24.   Sensitivity  of  g  and  h  rms  estimate  errors  vs 

variation  in  Mu  stability  derivative. 


o 
m 


o 
o 

a, 

oo 


o 


o 
o 


LD 


H    RMS    ESTIMflTE    ERROR    VS    MU 

Figure   24 


-1 .00  -0.92  -0.84  -0.76  -0.68  ^0. 60 

MU       xlO"' 


50 


OJ 

•  ^ 

in" 


o 
in" 


Ul 


oo 
CD  .. 


CD 
(D 


LD 


-1.00 


WG    RMS    ESTIMniE    ERROR    VS    MU 

Figure  25 


-0.92 


-0.84 

MU        )<10 


0.76 


0.68 


•0.60 


Figures   25   &   26.      Sensitivity  of  w     and  Ug   rms   estimate  errors  vs 

variation  in  Mu  stability  derivative. 
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Figures   27   &   28.      Sensitivity  of  u  and  w  rms   estimate  errors  vs 

variation  in  Mw  stability  derivative. 
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Figures  29  &  30.   Sensitivity  of  q  and  9  rms  estimate  errors  vs 

variation  in  Mw  stability  derivative. 
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Figures  31  &  32.   Sensitivity  of  h  and  w  rms  estimate  errors  vs 

variation  in  Mw  stability  derivative. 
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Figures  33  &  34.   Sensitivity  of  u  and  h  rms  estimate  errors  vs 

variation  in  Mq  stability  derivative. 


CD 
CM 

00 


00 


00 


o 


00 


H    RMS    ESTIMATE    ERROR    VS    MQ 


Figure  34 


-1.20  -1.10 


-1.00 


-0.90  -0.80  H3.70 


MQ 


55 


o 
o 

LT)' 


O 
O 


Ul 


CD 
O 


O 

o 

Oj' 


U    RMS    ESTIMATE    ERROR    VS    MNDOT 


Figure  35 


0 ."si  -0.57  -0.52  -0.47  -0.42  H3 .  37 

MNDOT       KlQ-' 


Figures  35  &  36.   Sensitivity  of  u  and  w  rms  estimate  errors  vs 

variation  in  M^  stability  derivatives. 
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Figures  37  &  38.   Sensitivity  of  q  and  9  rms  estimate  errors  vs 

variation  in  Mw  stability  derivative. 
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Figures  39  &  40.   Sensitivity  of  h  and  Wg  rms  estimate  errors  vs 

variation  of  Mw  stability  derivative. 
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Figures   41   &   42.      Sensitivity  of  Vg  and  p   rms   estimate   errors  vs 

variation  in  Yv  stability  derivative. 
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Figures  43   &  44.      Sensitivity  of  6  and  Vgg  rms  estiamte  errors  vs 

variation  in  Yv   stability  derivative. 
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Figures  45  &  46.   Sensitivity  of  Vg  and  r  rms  estimate  errors  vs 

variation  in  N^  stability  derivative. 
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Figures  47  &  48.   Sensitivity  of  p  and  9  rms  estimate  errors  vs 

variation  of  N'  stability  derivative. 
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Figures  49  &  50 »   Sensitivity  of  ^   and  Vg_  rms  estimate  errors  vs 

variation  in  N'  stability  derivative. 
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Figures   51   &   52.      Sensitivity  of  Vg  and  r   rms   estimate   errors  vs 

variation   in  N'    stability  derivative. 
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Figures   53   &   54.      Sensitivity  of   9   and  Vg        rms   estimate   errors  vs 

variation  in  N^  stability  derivative. 
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Figures  55  &  56.   Sensitivity  of  Vg  and  r  rms  estimate  errors  vs 

variation  in  N'  stability  derivative, 
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Figures  57  &  58.   Sensitivity  of  p  and  0  rms  estimate  errors  vs 

variation  of  N'  stability  derivative. 
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Figures  59  &  60.   Sensitivity  of  ip   and  V3  rms  estimate  errors  vs 
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Figures  61  &  62.   Sensitivity  of  V3  and  r  rms  estimate  errors  vs 

variation  L'  stability  derivative. 


CO 

o' 


CD 


ceo 


-5.00 


R    RMS    ESTIMATE    ERROR    VS    LB' 


Figure  62 


-4.80 


4.60 
LB' 


-4.40     -4.20     ^4.00 


69 


ZT 

D 

RMS 

ESTIMflTE 

ERROR 

V5 

LB^ 

o~ 

Figure   63 

CO 
00 

« 

/ ' 

D 

CO^d" 

\ 

CD 

UJ 

2u. 
en 

/ 

a_o" 

y 

"^ 

CM 
CO 

1 

1                            I 

! 

1 

-5.00 


-4.80 


■14.60 

LB' 


-4.40 


-4.20 


-4.00 


Figures   63   &   64.      Sensitivity  of  ^  and  9   nns   estimate   errors  vs 

variation   in  L'    stability  derivative. 
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Figures  65  &  66.   Sensitivity  of  i>   and  Vgg  rms  estimate  errors  vs 

.variation  in  L'  stability  derivative. 
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Figures  67  &  68.   Sensitivity  of  Vg  and  r  rms  estimate  errors  vs 

variation  of  L'  stability  derivative. 
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Figures  69  &  70.   Sensitivity  of  p  and  0  nns  estimate  errors  vs 

variation  of  L'  stability  derivative. 
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Figures   71   &   72o      Sensitivity  of  ip  and  Vg     rms   estimate  errors  vs 

variation  of  L'    stabiltiy  derivative. 
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Figures  73  &  74,  Sensitivity  of  vg  and  r  rms  estimate  errors  vs 

variation  in  L*  stability  derivative. 
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Figures  75  &  76 „   S 


ensitivity  of  e  and  V6  rms  estimate  errors  vs 
variation  in  L'  stability  derivative.  • 
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V,   CONCLUSIONS  AND  RECOMMENDATIONS 

A.   CONCLUSIONS 

Using  steady-state  Kalman  Filters  as  observers  in  an 
inertial  navigation  system,  the  sensitivity  of  rms  estimate 
errors  to  inaccuracies  in  the  stability  derivatives  was 
studied.   The  conclusions  reached  at  the  end  of  this  research 
are  presented  in  two  parts  as  they  were  analyzed. 

1.   Longitudinal  Motion  Estimator 

a.  Numerical  variations  in  the  dimensional  deriv- 
atives ;  Xu,  Xw  and  Mq  do  not  show  any  important  effect  in  the 
rms  estimate  errors.   The  value  of  these  parameters  as  imple- 
mented in  the  filter  can  have  large  variations  with  respect 
to  their  nominal  values  (perhaps  a  tolerance  of  +20%) . 

b.  Changes  in  the  stability  derivatives;  Zu,  Mu 
and  Mw  are  reflected  with  variation  in  almost  all  the  rms 
estimate  errors.   In  particular,  large  variations  in  u  rms 
estimate  error  can  begin  to  be  important  in  terms  of  accuracy 
in  the  radial  position.   These  parameters  can  be  implemented 
in  the  dynamics  of  the  filter  with  some  degree  of  tolerance 
with  respect  to  their  true  value  (for  the  case  under  analysis 
no  more  than  +5%) , 

Co   The  most  important  effects  are  found  with  the 
variations  of  the  stability  derivatives;  Zw  and  Mw.   Zw  gives 
the  strongest  alterations  in  all  the  rms  estimate  errors  and 
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small  changes  (+2%  the  tolerance  in  the  case  under  study)  in 
this  parameter  are  unacceptable  in  the  filter.   For  Mw  the 
situation  is  quite  similar  and  the  value  of  this  derivative 
is  very  important.   In  general,  Zw  and  Mw  must  be  faithfully 
reproduced  in  the  filter. 

2.   Lateral  Motion  Estimator 

It  is  not  possible  to  use  the  SKF  as  an  observer 
under  the  particular  configuration  of  the  models  given  for 
lateral  motion.   The  filter  is  stable  but  with  a  narrow  margin 
of  stability.   The  most  minimiim  numerical  variation  (i.e., 
+1%)  in  the  value  of  any  stability  derivative  results  in  a 
failure  of  the  filter  due  to  divergence.   This  result  com- 
plements the  discussion  given  in  Ref.  [4].   Using  a  sub- 
optimal  filter  (with  modified  gains),  the  effect  of  the 
nximerical  variation  in  each  of  the  stability  derivatives 
are: 

a.  Numerical  variations  in  the  dimensional  deriva- 
tives; Yv,  N*  and  L'  do  not  cause  important  effects  in  any  of 
the  rms  estimate  errors.   The  reproduction  of  these  para- 
meters in  the  filter  are  not  required  to  be  too  accurate 
(considering  in  this  case  a  tolerance  of  +107o)  . 

b.  Np  is  a  parameter  that  only  accepts  small  vari- 
ations in  its  value  (in  the  problem  discussed,  2%  of  toler- 
ance) because  it  has  strong  effects  in  the  estimation  of  ^ 
rms  estimate  error. 
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c.  The  stability  derivative  N'  is  one  of  the  most 
important  in  terms  of  faithful  reproduction  in  the  dynamics 
of  the  filter.   In  general,  it  can  be  said  that  any  numerical 
variation  in  its  true  value  is  not  allowed, 

d.  Finally,  L'  and  L-^  present  the  most  dramatic 
situation,  because  a  minimum  change  in  its  value  is  reflected 
with  very  large  changes  in  the  estimation  of  rms  errors  and 

it  can  result  in  divergence  of  the  Kalman  Filter,   The  lateral 
motion  estimator  design  requires  that  these  stability  deriva- 
tives must  be  reproduced  in  the  filter  with  the  maximum  of 
accuracy,  otherwise,  the  result  can  be  failure  of  the  filter. 

Of  the  two  estimators  used  in  the  implementation  of 
the  INS,  the  lateral  filter  is  more  sensitive  to  variation  in 
its  parameter  value.   It  should  be  remembered  that  the  con- 
clusions reached  in  this  analysis  apply  specifically  to  the 
model  being  analyzed.   Other  models  involving  different 
missiles  may  indicate  different  sensitivities. 

Nevertheless,  it  is  felt  that  the  conclusions  presented 
in  this  thesis  are  of  general  validity, 

B,   SUGGESTIONS  FOR  FURTHER  ANALYSIS 

The  most  obvious  extension  of  the  work  would  be  to  test 
the  estimators  using  the  real  data  for  a  missile. 

Further  study  could  be  to  consider  the  same  problem  de- 
signing the  estimators  with  a  model  that  includes  the  addition 
of  the  estimation  in  position  in  order  to  analyze  the  problem 
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in  terms  of  miss  distance  in  radial  position  for  a  missile 
that  at  the  end  of  the  mid-course  guidance  phase  must  hit  a 
"basket"  (terminal  guidance  phase) , 
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VI,   SUMMARY 

The  great  advantage  of  the  analysis  in  the  sensitivity 
of  rms  estimate  errors  to  inaccuracies  in  the  stability 
derivatives  is  that  it  points  out  clearly  which  derivatives 
are  worthy  of  detailed  accurate  determination  and  which  are 
not. 

The  following  table  summarizes  the  level  of  importance  of 
each  of  the  stability  derivatives  in  the  implementation  of 
the  steady-state  Kalman  Filters  to  be  used  as  estimators  in 
an  INS, 
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APPENDIX  A 
LIST  OF  SYMBOLS 

Regular  Symbols  Definition 

A  Modal  transformation  of  F  matrix 

B  Modal  transofrmation  of  T   matrix 

C  Modal  transformation  of  H  matrix 

D  Dutch  roll  mode 

E  Destabilization  matrix 

F  System  dynamics  matrix 

f  Subscript  for  filter 

F'  Destabilized  matrix 

g  Subscript  for  wind  speed 

H  Measurement  matrix 

H  Heading  Mode 

h  Altitude 

INS  Inertial  Navigation  System 

K  Kalman  Filter  gain  matrix 

L  '       Rolling  moment  (about  X  axis) 

M  Pitching  moment  (about  Y  axis) 

MDS  Modal  destabilization 

N  Yawing  moment  (about  Z  axis) 

n  Non-white  gauss ian  noise 

P  Covariance  propagation  of  the  estimate 

error  matrix 

p  Perturbed  roll  rate 

Q  Covariance  matrix  of  w 

q  Perturbed  pitch  rate 

R  Covariance  matrix  of  v 

r  Perturbed  yaw  rate 

S  Spiral  mode 

SKF  Steady-state  Kalman  Filter 

T  Transformation  matrix 
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Regular  Symbols  Definition 

UNS  Undisturbed  neutrally  stable 

u  Perturbed  forward  speed  (along  X  axis) 

V  Forward  velocity 

V  Perturbed  side  velocity 

w  Driving  white  gauss ian  noise 

w  Perturbed  downward  velocity 

X  Reference  axis 

X  State  vector  of  the  system 

X  State  estimate  vector 

X  Estimate  error  vector 

V  Reference  axis 

z  Measurement  vector 

Z  Reference  axis 


Greek  Symbols  Definition 

^p  Heading  Angle 

9  Perturbed  pitch  attitude  angle 

(J)  Perturbed  bank  (roll)  angle 

3  Sideslip  angle 

r  Driving  noise  matrix 

a  Eigenvalue  constrain 

a  Standard  deviation 

C  Transformed  state  vector 


84 


APPENDIX  B 
AERODYNAMIC  DATA  AND  PROBABILISTIC  INFORMATION 

V  =  820  ft/s 

1.   Longitudinal  Model 

a.  Dimensional  Derivatives 

Xu  =  -0,015  1/s 

Xw  =  0.004  1/s 

Zu  =  -0.074  1/s 

Zw  =  -0.0806  1/s 

Mu  =  -0.0786  1/s-ft 

Mw  =  -0.0111  1/s-ft 

Mq  =  -0.924  1/s-rad. 

Mw  =  -0.00051  1/ft 

b.  Disturbance  Noise  Standard  Deviation 


ru  =  a^  =  1.15   1/s  (10  ft/s) 


2 


(7  ft/s  rms  gust  with  a  930-ft  correlation 
distance) . 

c.   Observation  Noise  Standard  Deviation 
aq  =  0.15  s   (0.01  rad/s) 
a^  =  0.05  s   (100  ft)2 

2.  ■  Lateral  Models 

a.   Dimensional  Derivatives 

Y^  =  -0.0868  1/s 
N^  =   2.14   l/s^ 
N^  =  -0.228   1/s 
N'  =  -0.0204  1/s 
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L^  =  -4.41   l/s^ 
L^  =  0,034  1/s 
L^  =  -1,181   1/s 

b.  Disturbance  Noise  Standard  Deviation 

a  =   1,63x10"   1/s   (7  ft/s  rms  gust  with  a 

930  ft  correlation  distance) 

c.  Observation  Noise  Standard  Deviation 
Qp  =  1.5x10"^  s 

G^   =  1,5x10"^  1/s 
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COMPUTER  OUTPUT 


Table  lo   rms  estimate  errors  for  longitudinal  motion  estimator 
with  variation  in  Xu  derivative. 


Xu 

u 
ft/s 

w 
ft/s 

q 

deg/s 

9 
deg 

h 
ft 

u 

g, 
ft/s 

ft/s 

-O0OI8 

2.096 

5.102 

0.416 

0.317 

8.248 

4.776 

5.701 

-0.0165 

2.094 

5.102 

0.416 

0.317 

8.246 

4.776 

5.701 

-0.01575 

2.091 

5.102 

0.416 

0o317 

8.240 

4.776 

5.701 

-0.015     * 

2.090 

5.102 

0.416 

0.317 

8.245 

4.776 

5.701 

-0.01425 

2.088 

5.103 

0.416 

0.317 

8.260 

4.775 

5.701 

-0.0135 

2.089 

5.103 

0.416 

0.317 

8.280 

4.775 

5.701 

-O0OI2 

2.092 

5.103 

0.416 

0.317 

8.340 

4.775 

5.701 

Table  2o   rms  estimate  errors  for  longitudinal  motion  estimator 
with  variation  in  Xw  derivative. 


Xw 

u 
ft/s 

w 
ft/s 

q 

deg/s 

9 
deg 

h 
ft 

ft/s 

w 

g 
ft/s 

0.0048 

2.070 

5.102 

0.416 

0.317 

8.319 

4.776 

5.701 

0.0044 

2.080 

5.102 

0.416 

0.317 

8.282 

4.776 

5.701 

0.0042 

2.086 

5.102 

0.416 

0.317 

8.257 

4.776 

5,701 

0.004       * 

2.090 

5.102 

0.416 

0.317 

8.245 

4.776 

5.701 

0.0038 

2.100 

5.102 

0.416 

0.317 

8,223 

4.776 

5,701 

0o0036 

2.103 

5.102 

0.416 

0.316 

8.215 

4.776 

5.701 

0.0032 

2.110 

5.101 

0.416 



0,316 

8.170 

4.776 

5.701 
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Table  3.   rms  estimate  errors  for  longitudinal  motion  estimator 
with  variation  in  Zu  derivative. 


Zu 

u 
ft/s 

w 
ft/s 

q 

deg/s 

9 
deg 

h 
ft 

u 
ftfs 

ft?s 

-0.0888 

1.885 

5.106 

0.416 

0o322 

9.310 

4.776 

5.707 

-0.0814 

1,974 

5.104 

0.416 

0o319 

8.808 

4.775 

5.703 

-0.0777 

2.026 

5.194 

0.416 

0.318 

8.579 

4.775 

5.702 

-Oo0740  * 

2.090 

5.102 

0o416 

0.317 

8.245 

4.776 

5.701 

-0.0703 

2.122 

5.100 

0.416 

0.315 

7.800 

4.777 

5.700 

-O0O666 

2.270 

5.095 

0.416 

0.313 

7,101 

4.777 

5.697 

-O0O592 

2.32 

5.094 

0.416 

0.311 

7.000 

4.778 

5.695 

Table  4.   rms  estimate  errors  for  longitudinal  motion  estimator 
with  variation  in  Zw  derivative. 


Zw 

u 
ft/s 

w 
ft/s 

q 

deg/s 

9 
deg 

ft 

u 
ft?s 

w 
ft?s 

-0.9612 

30.08 

6.172 

0.486 

0.440 

17.97 

4.778 

7,138 

-0.8866 

11.80 

5.810 

0.428 

0.415 

33.50 

4.785 

5.947 

-0.8463 

5/345 

5/259 

0.421 

0.400 

22.776 

4,779 

5.737 

-0.806  * 

2.090 

5,102 

0.416 

0.317 

8.245 

4.776 

5.701 

-0.7657 

2.668 

5,032 

0.412 

0.219 

16.903 

4.772 

5.710 

-0.7256 

3.188 

5.035 

0.407 

0.200 

21.026 

4.769 

5.746 

-0,665 

3.260 

5.065 

0.406 

0.185 

23.000 

4.767 

5.794 
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Table  5.   rms  estimate  errors  for  longitudinal  motion  estimator 
with  variation  in  Mu  derivative. 


Mu 

u 
ft/s 

w 
ft/s 

q 

deg/s 

e 

deg 

h 

ft 

u_ 
ft/s 

""g 
ft/s 

-0.000943 

2.234 

5.061 

0.416 

0.305 

6.230 

4.775 

5.689 

-0.000865 

2.115 

5.089 

0.416 

0.310 

6.640 

4.775 

5.695 

-0.000825 

2.104 

5.094 

0.416 

0.314 

7.531 

4.776 

5.698 

-0.000786* 

2.090 

5.102 

0.416 

0.317 

8.245 

4.776 

5.701 

-0.000747 

1.993 

5.105 

0.416 

0.318 

8.595 

4.777 

5.703 

-0.000707 

1.866 

5.108 

0.416 

0.319 

8.832 

4.779 

5.705 

-0.000629 

1.566 

5.111 

0.416 

0.322 

9.178 

4.783 

5.708 

Table  6.   rms  estimate  errors  for  longitudinal  motion  estimator 
with  variation  in  Mw  derivative. 


Mw 

ft/s 

w 
ft/s 

q 

deg/s 

5 
deg 

h 

ft 

^g 
ft/s 

^g 
ft/s 

-0.01165 

18.43 

8.350 

0.502 

0.455 

29.870 

4.778 

5.695 

-0.0113 

5.163 

5.142 

0.433 

0.373 

17.790 

4.778 

5.694 

-0.0112 

3.110 

5.113 

0.418 

0.321 

10.427 

4.777 

5.699 

-0.0111* 

2.090 

51.102 

0.416 

0.317 

8.245 

4.776 

5.701 

-0.0109 

5.206 

5.018 

0.419 

0.325 

16.650 

4.776 

5.700 

-0.01055 

13.652 

5.342 

0.447 

0.430 

12.204 

4.776 

5.918 

-0.00999 

19.13 

18.95 

0.475 

0.704 

68.98 

4.756 

6.102 
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Table  7.   rms  estimate  errors  for  longitudinal  motion  estimator 


with  variation  in 

Mq  derivative. 

« 

Mq 

u 

ft/s 

w 
ft/s 

q 

deg/s 

e 

deg 

h 
ft 

"g 
ft/s 

w 

g 
ft/s 

-1.109 

2.091 

5.102 

0.416 

0.316 

8.230 

4.776 

5.701 

-1.016 

2.091 

5.102 

0.416 

0.316 

8.234 

4.776 

5.701 

-0.970 

2.091 

5.102 

0.416 

0.317 

8.236 

4.776 

5.701 

-0.924* 

2.090 

5.102 

0.416 

0.317 

8.245 

4.776 

5.701 

-0.880 

2.090 

5.102 

0.416 

0.316 

8.244 

4.776 

5.701 

-0.832 

2.089 

5.102 

0.416 

0.316 

8.236 

4.776 

5.701 

-0.7392 

2.089 

5.102 

0.416 

0.316 

8.232 

4.776 

5.701 

Table  8.   rms  estimate  errors  for  longitudinal  motion  estimator 
with  variation  in  M^  derivative. 


Mw 

u 

ft/s 

w 
ft/s 

q 

deg/s 

e 

deg 

h 
ft 

u 
ftfs 

w 
ftfs 

-0.00061 

2.610 

5.053 

0.417 

0.273 

10.665 

4.775 

5.688 

-0.00056 

2.476 

5.089 

0.417 

0.295 

6.301 

4.776 

5.703 

-0.00053 

2.398 

5.091 

0.417 

0.304 

4.150 

4.776 

5.698 

-0.00051* 

2.090 

5.102 

0.416 

0.317 

8.245 

4.776 

5.701 

-0.00049 

2.491 

5.108 

0.416 

0.322 

9.757 

4.776 

5.702 

-0.00046 

2.976 

5.118 

0.415 

0.332 

12.067 

4.776 

5.703 

-0.00041 

3.570 

5.124 

0.415 

0.340 

13.536 

4.776 

5.703 
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Table  9.   rms  estimate  errors  for  lateral  motion  estimator  with 
variation  in  Y  derivate. 


Yv 

vB 

ft/s 

r 
deg/s 

P 
deg/s 

e 

deg 

des 

ftJs 

-.10416 

3.914 

0.246 

0.380 

0o236 

0.216 

5.743 

-.09548 

3.856 

0.246 

0.379 

0.231 

0.216 

5.728 

-.09110 

3.827 

0.245 

0.379 

0.228 

0.216 

5.719 

-.0868  * 

3.799 

0.245 

0.379 

0.226 

0.216 

5.719 

-.08246 

3.769 

0.245 

0.378 

0.223 

0.215 

5.702 

-.07812 

3.741 

0.245 

0.378 

0.220 

0.215 

5.694 

-.06944 

3.678 

0.245 

0.377 

0.214 

0.215 

5.677 

Table  10.   rms  estimate  errors  for  lateral  motion  estimator 
with  variation  in  Ni  derivative. 


^6 

^6 
ft/s 

r 
deg/s 

P 
deg/s 

5 
deg 

deg 

V3g 

ft/s 

2.354 

6.889 

0.280 

0.391 

0.649 

0.233 

7.719 

2.247 

5.129 

0.266 

0.384 

0.501 

0.230 

6.220 

2.1828 

4.717 

0.253 

0.383 

0.404 

0.223 

6.052 

2.14  * 

3.799 

0.245 

0.379 

0.226 

0.216 

5.712 

2.0972 

4.125 

0.237 

0o371 

0,325 

0,217 

5.938 

2.033 

4.956 

0.224 

0.353 

0.655 

0.218 

6.543 

1.926 

8.781 

0.201 

0.299 

1.101 

0.220 

8.240 
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Table  11.   rms  estimate  errors  for  lateral  motion  estimator 


1 

vith  variation  in 

N^  derivative. 

K 

Vg 
ft/s 

r 
deg/s 

P  , 
deg/s 

9 
deg 

deg 

ft/s 

-0.2736 

3.790 

0.248 

0,380 

0»225 

0.217 

5.704 

-0.2508 

3.791 

0.246 

0.379 

0.225 

0.216 

5.706 

-0.2394 

3.794 

0.246 

0.379 

0.225 

0o216 

5.710 

-0,228  * 

3.799 

0.245 

0.379 

0,226 

0.216 

5.712 

-0.2166 

3.805 

0.245 

0.379 

0.226 

0.216 

5.714 

-0.2052 

3.815 

0.246 

0.379 

0.228 

0.216 

5.719 

-0.1824 

3.834 

0.248 

0.379 

0.231 

0.216 

5.727 

Table  12.   rms  estimate  errors  for  lateral  motion  estimator 
with  variation  in  Np  derivative. 


^P 

ft/s 

r 
deg/s 

P 
deg/s 

9 
deg 

deg 

^6g 
ft/s 

-0.02448 

4.121 

0.247 

0.380 

0.318 

0.218 

5.826 

-0.02244 

3.980 

0.246 

0.380 

0.277 

0.217 

5.768 

-0.02142 

3.889 

0.246 

0.379 

0.253 

0.216 

5.742 

-0.0204  * 

3.799 

0.245 

0.379 

0.226 

0.216 

5.712 

-0.01938 

3.719 

0.245 

0,379 

0.198 

0.216 

5.745 

-0,01836 

3.708 

0.246 

0.379 

0.183 

0.216 

5.813 

-0.01632 

3.695 

0.248 

0.382 

0.173 

0.217 

6.029 
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Table  13.   rms  estimate  errors  for  lateral  motion  estimator 


with  variation  in 

^e- 

H 

ft/s 

r 
deg/s 

p 

deg/s 

e 

deg 

deg 

ftfs 

-4.8510 

7.498 

0.120 

0.338 

0.885 

0.089 

2.266 

-4.6305 

5.621 

0.205 

0.360 

0.539 

0.178 

4,244 

-4.4982 

4.642 

0.240 

0.375 

0.236 

0.211 

5.529 

-4.41  * 

3.799 

0.245 

0.379 

0.226 

0.216 

5.712 

-4.3659 

4.268 

0.249 

0.382 

0.319 

0.219 

5.875 

-4.3218 

4.640 

0.250 

0.390 

0.402 

0.220 

6.295 

-4.1895 

5.246 

0.253 

0.393 

0.492 

0.224 

6.238 

Table  14.   rms  estimate  errors  for  lateral  motion  estimator 
with  variation  in  L^. 


K 

V3 

ft/s 

r 
deg/s 

P 
deg/s 

0 
deg 

deg 

ft/s 

-0.3674 

12.030 

0.233 

0.352 

0.205 

0.300 

8.149 

-0.3507 

11.538 

0.236 

0.363 

0.208 

0.292 

7.910 

-0.3407 

10.712 

0.240 

0.370 

0.213 

0.276 

1.1  he 

-0.334  * 

3.799 

0.245 

0.379 

0.226 

0.216 

5.712 

-0.3273 

9.476 

0.209 

0.365 

1.089 

0.249 

6.613 

-0.3173 

10.712 

0.206 

0.354 

1.551 

0.252 

7.198 

-0.3006 

11.248 

0.197 

0.350 

1.986 

0.266 

7.309 
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Table  15.   rms  estimate  errors  for  lateral  motion  estimator 


with  variation  in 

Lp. 

K 

ye 

ft/s 

r 

dea/s 

P 
deg/s 

9 
deg 

deg 

ft/s 

-1.299 

3.846 

0.254 

0.380 

0.228 

0.219 

5.723 

-1.240 

3.812 

0.248 

0.379 

0.227 

0.217 

5.719 

-1.204 

3.799 

0.246 

0.379 

0.226  . 

0.216 

5.714 

-1.181  * 

3.799 

0.245 

0.379 

0.226 

0.216 

5.712 

-1.1573 

3.801 

0.246 

0.379 

0.226 

0o216 

5.712 

-1.122 

3.807 

0.248 

0.379 

0.226 

0.217 

5.713 

-1.063 

3.848 

■ 

0.255 

0.379 

0.227 

0o220 

5.719 
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ccccccccccccccccccccccccccccccccccccccccccccccccccccccccccc 
c  c 

C  SENSITIVITY  COVARIANCE  PROGRAM  C 

c  c 

C  THIS  PROGRAM  IS  USED  TO  SOLVE  THE  ERROR  SENSITIVITY  C 

C  EQUATIONS  WHEN  THERE  IS  AN  INCORRECT  IMPLEMENTATION  C 

C  OF  DYNAMICS  IN  THE  DESIGN  OF  THE  KALMAN  FILTER. THE  C 

C  EQUATIONS  BECOME  C 

c  c 

C  POOT=(F*-K*HI  P+P(F*-K*H)T+OFV-fVTDFT  +  GQGT  +  K=<'RK*T  C 

C  VOOT=FV+V{F*-K*H)T+UDFT-GQGT  C 

C  U0OT=FU-t-UFT+GQGT  C 

c  c 

C      THE  PRINCIPAL  PROGRAM  INPUTS  ARE  THE  FOLLOWING  CO-    C 
C      LLECTION  OF  SYSTEM  AND  FILTER  MATRICES  C 

c  c 

C               PO          THE     INITIAL    COVARIANCE    MATRIX(NXN)  C 

C               F            THE    TRUTH    MODEL    DYNAMICS    MATRIX(NXN)  C 

F*         THE    FILTER    MODEL    DYNAMICS    MATRIX(NXN)  C 

C              H            THE    TRUTH    MODEL    MEASUREMENT    MATRIX( LXN ), WHERE  C 

C                           L    IS    THE    MEASUREMENT    VECTOR    DIMENSION  C 

C              GQGT    THE    INPUT    NOISE    COVARIANCE    MATRIX(NX)  C 

C              R            THE    MEASUREMENT    NOISE    COVARIANCE    MATRIX(LXLJ  C 

C              K*         FILTER    GAIN(NXL)  C 

C  C 
CCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCC 
C 

c 

C  THIS    PROGRAM    HAS    BEEN    DEVELOPED    USING   THE     IMSL    LIBRARY 

C  AVAILABLE    IN    THE    COMPUTER    CENTER    OF    THE    NAVAL 

C  POSTGRADUATE    SCHOOL 
C 

c 

IMPLICIT  REAL*8  (A-H,0-Z) 

COMMON  F(7,7),FS(7,7) »GQGT(7) ,AK(7,2)»R(2,2), 
*AKRKT(7,7),0F{7,7) ,FT( 7,7) ,FSMKHT( 7, 7) ,DFT ( 7 , 7) , 
*FSMKH(7,7),H(2,7) 

COMMON/KTR/N,NS,NPD 

DIMENSION  PFULL(7,7),PSQR(7) 

DIMENSION  DDT(7) 

DIMENSION  U(28) ,V(7,7) ,P(28) ♦U0(28) ,VD(7 
*VAR(105),DRV( i05) ,C(24),WK(105,9) ,PD(28) 

DIMENSION  TMP1(7,7) ,TMP2(7,7) ,THP3(7,7) 

EQUIVALENCE    (  U(  I )  ,  VAR(  D)  ,(V{i,l)  ,VAR(29)  )  ,  (P(I)  , 
*VAR(78) )» (UD(1),3RV(1)  ) , ( VO ( 1 , 1 ) , DRV ( 29) ) , ( P0( I ) , 
*DRV(78) ) 
C 

C  N=ORO£R    OF    THE   SYSTEM    MODEL 

C 

C  NP=NUMBER    OF    POINTS 

C 

C  NPD=CONTROL    OF    INITIAL    DIAGNOSTIC    OUTPUT 

C 

C  DT=TIME    INTERVAL 

C 

EXTERNAL    FUN 

CALL    UGETI0(3,5,6) 
C 
C 

C      THE  FOLLOWING  SECTION  READS  THE  SPECIFIED  INPUT 
C      MATRICEStF,F*,GQGT,K«H  AND  R 


C 

c 


7) 


READ(5,98 )N,NPtNPDtDT 
93    F0RMAT(3I5,FI0.5) 

WRITE{6,97)N,NP,NP0,DT 
97    FORMAT(U«  ,3I5,1X,G18.10) 


95 


c 


NS=N*{N+1 )/2 
N1=NS+N**2+1 
NV=2*NS+N**2 
99    fORMAT{8F10.5) 

00    1    I=ltN 

1  READ(5,99)     ( F { I , J ) , J=l , N ) 
CALL    USWFH( 'F* ,1»F,7,N,N,L) 

DO    2    1=1, N 

2  R£A0(5,99)     ( F S( I , J )  , J=l tN) 
CALL    USWFM(  •FS»,2,FSt7,N,^J,  1) 
READ(5,99)     ( GQGT ( I ) , 1=1 ,N J 
CALL    USWFV( •GQGT* ,4,GQGT,N,1,1) 

OG    3    I=1tN 

3  REA0(5,99)     { AK( I , J )  , J=l »2 ) 
CALL    USWFM( •K',1»AK,7,N,2,1) 

DO    4    1=1,2 

4  REA0(5,99)     ( H ( I , J ) , J=l ,N I 
CALL    USWFMCH' ,1,H,2,2,N,1) 

00    5    1=1,2 

5  READ(5,99)     ( R ( I , J ) , J=l , 2) 
CALL   USWFM( 'RSI, R, 2,2,2, IJ 

00    6    1=1,105 

6  VAR(I)=0. 
DO    7    1=1, N 
DO    7    J=1,N 

C 

7  OF{I,J)=FS( I, J)-F( I,J» 

CALL    USWFM(«DEL    F • , 5,0F  ,7  ,N ,M  ,1 ) 
CALL    VMULFF(AK,R,N,2,2,7,2,TMP1,7,IER) 
CALL    VMULFP(T,^Pli  AK,N,2  ,N,  7  ,7  ,  AKRKT,  7,  lER) 
CALL    USWFiM(  'KRKT*  ,  4,  AKRKT  ,7  ,iN|  ,N  ,  1  } 
C 

C  CALCULATE    THE    DIFFERENCE    BETWEEN    THE    DYNAMICS 

C  IMPLEMENTED    IN    THE    FILTER    AND    THE    PLANT,    DF=F*-F 


C 
C 

c 

c 


c 


c 


DO  20  1=1 ,N 
DO  20  J=1,N 
DFT(I,J)=DF(I,J) 

20  FT{I,J}=F(I,J) 

CALL    VTRANX(0FT,M,N,7) 

CALL    USWFMCOEL    FT  •  ,6,  DFT,7  ,N  ,N  ,  1  ) 

CALL    VTRANX(FT,^,N,7) 

CALL   USWFM( •FT',2,FT,7,N,N,1) 

CALL    VMULFF{AK,H,N,2,N,7,2,TMP1,7,IER) 

DO  21  1=1,7 
DO  21  J  =  l  ,7 
FSMKHd  ,J)=FS(I,  J)-TMP1(I,JI 

21  FSMKHTd,  J)=FSMKH(  I  ,J) 

CALL    USWFM( 'FS-KH* , 5,FSMKH, 7, N, N , 1) 

CALL    VTRANX(FSMKHT.N,N,7) 

CALL    USWFM( • (FS-KH)T« , 8 ,FSMKHT ,7 , N ,N , 1 ) 

T=0. 

T0L=l.D-5 

IN0  =  1 

L=0 

IF(N.EQ.7}    GO    TO    11 

DO    31    1=1 ,NS 
L=L  +  l 
31    VAR(L)=U(  n 
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DO  32  1  =  1  ,N 
DO  32  J  =  l  ,N 
L=L  +  1 

32  VAR(LJ=V(  If  J) 
C 

DO  33  I=1,N 
L=L  +  1 

33  VAR(L)=P(  I) 
li    DO     10    K=1,NP 

C  TEND=FIiNAL    TI.M6 

C 

T£NC=K*DT 
C 

C  DVERK    SUBROUTINE    FINOS    THE    SOLUTION    OF    THE    SYSTEM    OF 

C  DIFFERENTIAL    EQUATIONS 

C 

CALL    OVERK<NV,FJNTT,VARtTENO,TOLt IND,C,I35,WK,IER) 

IF<INO.LE.O.OR.IER.NE.O)STOP 

CALL  VCVTSF( VAR(Nl) ,NtPFULL,7  ) 
C 

C      CALCULATE  AND  PRINT  THE  R;-IS  ESTIMATE  ERRORS 
C 

DO  30  1=1, N 
30  PSQR{n=OSQRT(PFJLL(  I»I)  ) 

WRITE(6,90)T,(PSQR(I),I=1,N) 
90  FORMAT( •0T=' ,F10.5, •  PSR= • , 7S 15. 7) 
C 

C      IF  DESIRED  PRINT  THE   COVARIANCE  MATRICES, P,U  AND  V 
C      CALL  USWSM( •U«,1»U,N,2) 
C      CALL  USWFM( 'V* ,1,VAR(NS+1),7,N,N,2) 
C      CALL  USWSM( •P«,1,VAR(N1),N,2) 
10  CONTINUE 

STOP 

END 
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SUBROUTINE    VTRA^iX  (  A  ,  N,  NCt  lA  I 
IMPLICIT    REAL*8    (A-HtO-Z) 
DIMENSION    A(IA,IA) ,B(7,7) 

00  1  1=1, N 
00  1  J=1,N 
B(I ,J)=a( J,  I) 

00  2  1=1, N 
00  2  J=lfN 
A{I,J)=B( I, J) 

RETURN 
END 
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SUBROUTINJE    FUN(\IV,T,VARfDRV) 
C 

c 

C      FCN  SUBROUTINE  IS  USED  FOR  EVALUATING  FUNCT I ONS ( INPUT) 
C 

c 

IMPLICIT    REAL*8    (A-H,0-Z) 

COMMON    F( 7,7) ,FS(  7, 7),GQGT(  7),AK(7,2),R(2,2), 
*Ai<RKT(7,7)  ,DF(7,7)  ,  FT(  7  ,7  )  ,  FSMKHT  (  7  ,  7)  ,  OFT  (7,  7), 
*FSMKH(7,7) ,H( 2,7) 

COMMaN/KTR/N,NS,NPD 

DIMENSION    U(28),V(7t7),P<28),UD(28),VD(7,7), 
*VAR(105), DRV( 105) ,C(2^) ,WK( 10  5,9) ,PD(28) 

DIMENSION    TMP1(7,7),TMP2(7,7) ,TMP3(7,7) 
C 

L=0 

00    1    1=1, NS 

L  =  L  +  1 

1  U( I)=VAR(L) 
C 

00  2  1=1, N 
DO  2  J  =  1,N 
L=L-M 

2  V(I,J)=VAR(L) 
C 

DO    3    1=1, NS 
L=L  +  1 

3  P(I)=VAR(L) 
IF(T.EQ.O)KT=NPO 
KT=KT+1 

IF     (KT.GE.5  )    GO    TO    15 
WRITE(6,99)     T 
99    FORMAT( •0T=» ,025.15) 

CALL    USWSM(«U»,1,U,N,2) 
CALL    USWFM( •V»,1,V,7,N,N,2) 
CALL    USWSM( •P»,lfV,N,2) 
15    CALL    VMULFS(F,U,i^,N,7,TMPl,7) 

IF(KT.LT.5)     CALL    U SWFM ( • FU» , 2 ,TMP 1 , 7 ,N ,N, 2) 
CALL    VMULSF(U,N,FT,N,7,TMP2,7) 
IF(KT.LT.5)     CALL    USWFM( 'UFT « , 3 ,TMP2 ,7,N, N, 2 ) 
C 

DO  5  1=1, N 
00    4    J=1,N 

4  TMPK  I,  J)=TMP1(  I,  J)+TMP2(I.  J) 

5  TMP1{I,I)=TMP1(I, I )+GQGT(I) 
CALL    VCVTFS(TMP1,N,7,UD) 

IF{KT.LT.5)    CALL    US WSM ( 'UDOT* , 4,U0 ,N ,2 ) 
CALL    VMULFF(F,V,N,N,N,7,7,TMP1,7, lER) 
IF(KT.LT.5)     CALL    U SWFM ( *FV« , 2 ,TMP 1 ,7  ,N ,N, 2 ) 
CALL    VMULFF(V,FSMKHT,N,N,N,7,7,TMP2,7,IER) 
IF{KT.LT.5)    CALL    USWFM( • V*( FS-KH) T • , 10 , TMP2, 7 ,N,N, 2 ) 
CALL    VMULSF(U,N,DFT,N,7,TMP3,7) 

IF(KT,LT.5)    CALL    U5WFM(  •U*OFT • , 5 , TMP3,7 ,N, N , 2  ) 
C 

DO  7  1=1, N 
00    6    J=1,N 

6  V0(  I,  J)=TMP1(  I,J)+TMP2(I,J)-t-TMP3(  I,  J) 

7  VJ( I,I)=VD( I, I)-GQGT(I) 

IF(KT.LT.5)    CALL    USWFM( • VDOT • ,4, V0,7,N, N, 2 ) 

CALL    VMULFS( FSMKH . P ,N . N, 7, TMPi , 7 ) 
IF(KT.LT.5)    CALL  ,USWFM ( • < FS-KH) P • , 8, TMPl , 7 ,N , N, 2) 
CALL    VMULSF(P,N,FSMKHT,N,7,TMP2.7) 

IF(KT.LT.5)     CALL    US WFM ( • P (FS- KH) T ' , 9,TMP2 , 7 ,N  ,N  ,2) 
CALL    VMULFF(DF,V,N,N,N,7,7,TMP3,7,I£R) 
IF(KT.LT.5)     CALL    US WFM ( • OF*V«  ,4, TMP3 ,7 , N, N, 2  ) 
C 

DO    8    1=1, N 
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c 


c 


c 


00    8    J=1,N 

8  TMPKI,  J)=TMP1(  I,  JJ+TMP2(  I ,  J  ) +TMP3  (  1 1  J  ) 
CALL    VMULFiM(V,DF,N,NiN,7,7»TMP3,7tieR) 
IF(KT.LT.5)     CALL    USWFM  (  •  VT*OF  •  ,  5,  THP3  ,  7,\|  ,N  ,2  ) 

00  10  1=1, N 
DO    9    J  =  1,N 

9  TMP3(I, J) =TMP1( I, J)+TMP3( I . J ) +AKRKT (I » J ) 

10  TMP3(I,n=TMP3(I  ,  D^GQGK  n 

IF(KT.LT.5)    CALL    USWFM  (  •PDOT*  ,  4,  TiMP3  ,7,  N  ,  N  ,  2  ) 

CALL    VCVrFS{TMP3 ,N,7,PD) 

IF(KT.LT.5)    CALL    US WFV ( • POOT { SYM) • , 9, PD,N , 1 , 2 > 

L=0 

DO    11    1  =  1, NS 
L=L  +  1 

11  DRV(LI=UO(n 

DO  12  1=1  ,N 
DO  12  J=1,N 
L=L  +  1 

12  DRV(L)=VD{I,J) 

DO    13    1=1, NS 
L  =  L  +  1 

13  ORV(L)=PD(I) 

IF(KT.LT.5)    CALL    USWFV ( 'ORV • , 3, DRV,MV  ,  1,  2  ) 

RETURN 

END 
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